//
// Created by Aron on 2024/11/2.
//

#include "Suction_cup.h"
#include "remote_control.h"
void Suction_control(void){
    if (rc_ctrl.rc.s[0]==1) {
        if (rc_ctrl.rc.s[1] == 3) {
            HAL_GPIO_WritePin(Pumps_GPIO_Port, Pumps_Pin, GPIO_PIN_RESET);
            HAL_GPIO_WritePin(E_valve_S_GPIO_Port, E_valve_S_Pin, GPIO_PIN_RESET);
            HAL_GPIO_WritePin(E_valve_L_GPIO_Port, E_valve_L_Pin, GPIO_PIN_RESET);
        } else if (rc_ctrl.rc.s[1] == 1) {
            HAL_GPIO_WritePin(Pumps_GPIO_Port, Pumps_Pin, GPIO_PIN_SET);
            HAL_GPIO_WritePin(E_valve_S_GPIO_Port, E_valve_S_Pin, GPIO_PIN_RESET);
            HAL_GPIO_WritePin(E_valve_L_GPIO_Port, E_valve_L_Pin, GPIO_PIN_SET);
        } else if (rc_ctrl.rc.s[1] == 2) {
            HAL_GPIO_WritePin(Pumps_GPIO_Port, Pumps_Pin, GPIO_PIN_SET);
            HAL_GPIO_WritePin(E_valve_S_GPIO_Port, E_valve_S_Pin, GPIO_PIN_SET);
            HAL_GPIO_WritePin(E_valve_L_GPIO_Port, E_valve_L_Pin, GPIO_PIN_RESET);
        }
    }
}